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SUMMARY 

This paper is concerned with a flexible space robot capable of maneuvering payloads. The 
robot is assumed to consist of two hinge-connected flexible arms and a rigid end-effector holding 
a payload; the robot is mounted on a rigid platform floating in space. The equations of motion are 
nonlinear and of high order. Based on the assumption that the maneuvering motions are one order 
of magnitude larger than the elastic vibrations, a perturbation approach permits design of controls 
for the two types of motion separately. The rigid-body maneuvering is carried out open loop, but 
the elastic motions are controlled closed loop, by means of discrete-time linear quadratic regulator 
theory with prescribed degree of stability. A numerical example demonstrates the approach. In the 
example, the controls derived by the perturbation approach are applied to the original nonlinear 
system and errors are found to be relatively small. 


1. INTRODUCTION 

A variety of space missions can be carried out effectively by space robots. These missions 
include the collection of space debris, recovery of spacecraft stranded in a useless orbit, repair of 
malfunctioning spacecraft, construction of a space station in orbit and servicing the space station 
while in operation. To maximize the usefulness of the space robot, the manipulator arms should be 
reasonably long. On the other hand, because of weight limitations, they must be relatively light. 

To satisfy both requirements, the manipulator arms must be highly flexible. Hence, space robots 
share some of the dynamics and control technology with articulated space structures. 

Robotics has been an active research area for the past few decades, but applications have been 
concerned primarily with industrial robots, which are ground based and tend to be very stiff and 
bulky. In contrast, space robots are based on a floating platform and tend to be highly flexible. 
Hence, whereas industrial and space robots have a number of things in common, the differences are 
significant. More recent investigations have been concerned with flexible industrial robots (Refs. 
1-4). On the other hand, some investigations are concerned with space robots consisting of rigid 
links (Refs. 5-7). Research on flexible space robots has come to light only recently (Refs. 8,9). 
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This paper is concerned with a flexible space robot capable of maneuvering payloads. The 
robot is assumed to consist of two hinge-connected flexible arms and a rigid cnd-effec or holding 
a payload- the robot is mounted on a rigid platform floating in space (Fig. 1). The platform 
is capable of translations and rotations, the flexible arms are capable of rotations and elastic 
deformations and the end-effector/payload can undergo rotat.ons relative to the connecting flexib e 
arm Based on a consistent kinematical synthesis, the motions of one body in the chain take into 
consideration the motions of the preceding body in the chain. This permits the derivation of the 
equations of motion without the imposition of constraints. The equations of motion are derive y 
the Lagrangian approach. The equations are nonlinear and of relatively high order. 

Ideally, the maneuvering of payloads should be carried without exciting elastic vibration 
which is not possible in general. However, the elastic motions tend to be small compared to the 
rigid-bodv maneuvering motions. Under such circumstances, a perturbation approach permi s 
separation of the problem into a zero-order problem (in a perturbation theory sense) for the 
rigid-body maneuvering of the space robot and a first-order problem for the control of the elastic 
motions and the perturbations from the rigid-body motions. The maneuvering can be earned out 
open loop, but the elastic and rigid-body perturbations are controlled closed loop. 

The robot mission consists of carrying a payload over a prescribed trajectory and placing it 
in a certain orientation relative to the inertial space. For planar motion, the end-effector/payload 
configuration is defined by three variables, two translations and one rotation. At the end of the 
mission, the vibration should be damped out, so that the robot can be regarded as rigid at that 
time Still, the rigid robot possesses six degrees of freedom, two translations of the platform an 
one rotation of each of the four bodies, including the platform. This implies that a kinematic 
redundancy exists. This redundancy is removed in the trajectory planning so as to conserve ue . 

For a given end-effector/payload trajectory, the rigid-body maneuvering configuration of the 
robot can be obtained by means of inverse kinematics. Then, the forces and torques required for 
the robot trajectory realization are obtained from the zero-order equations by means of inverse 

dynamics. 

The first-order equations for the elastic motions and the perturbations in the rigid-body 
maneuvering motions are linear, but of high order, time- varying and they are subjected to 
persistent disturbances. The persistent disturbances are treated by means of feedforward contro . 
All other disturbances are controlled closed loop, with the feedback controls being designed by 
means of discrete-time linear quadratic regulator (LQR) theory with prescribed degree of stability. 
A numerical example demonstrates the approach. In the example, the controls derived by the 
perturbation approach are applied to the original nonlinear system and the errors in the end- 
effector / payload configuration were found to be relatively small during the maneuver and to vanish 
soon after the termination of the maneuver. 


2. A CONSISTENT KINEMATICAL SYNTHESIS 

To describe the motion of the space robot, it is convenient to adopt a consistent kinematical 
synthesis whereby the system is regarded as a chain of bodies and the motion of one body is 
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defined with due consideration to the motion of the preceeding body in the chain. Figure 1 shows 
the mathematical model of the space robot, consisting of a rigid platform (Body 1), two hinge- 
connected flexible arms (Bodies 2 and 3) and a rigid end-effector holding the payload (Body 4). 
The various motions are referred to a set of inertial axes and sets of body axes to be defined 
shortly. 


The object is to derive the system equations of motion, which can be done by means of 
Lagrange s equations in terms of quasi-coordinates (Ref. 10). Because in the case at hand the 
motion is planar, it is more expedient to use the standard Lagrange’s equations. This requires the 
kinetic energy, potential energy and virtual work. The kinetic energy, in turn, requires the velocity 
of a typical point in each of the bodies. 


The position of a nominal point on the platform is given by 

B-i — Rq + iq 


( 1 ) 


T 

where R 0 = [X Y] is the position vector of the origin 0\ of the body axes X\ ,y x (Fig. 1) relative 
to the inertial axes X, V and in terms of .V, Y components and ri ~ [xi yi]^ is the position 
vector of the nominal point on the platform relative to the body axes x\,y\ and in terms of x\ 
components. The velocity vector of a point on the platform can be expressed in terms of x\,y\ 
components as follows: 

V! = CiRo + ^iri (2) 

where 

c0\ s0\ 

—s0\ c0\ 


Cx = 


(3) 


is a matrix of direction cosines between axes £|,yj, and X, Y, in which s#i =sin0j, c0\ — cos0 \ , 


R 0 = [* rf 

is the velocity vector of 0\ in terms of .Y, Y components and 


uq 


0 -0j 

01 0 


(4) 


(5) 


The second body is flexible, so that we must resolve the question of body axes. We define the 
body axes x 2 , yi as a set of axes with the origin at the hinge 0 2 and embedded in the undeformed 
body such that X 2 is tangent to the body at O 2 (Fig. 2). Then, we define the motion of axes x 2 ,y 2 
as rigid-body motion and measure the elastic motion relative to x 2 ,y 2 - Hence, the velocity of a 
point in the second body (first flexible arm) in terms of x 2 ,y 2 components is 

V 2 =C 2 _,V, (0 2 ) + Cj 2 (r 2 + u 2 ) + u 2re i 

=C 2 R 0 + C 2 _ idqr! (0 2 ) +d> 2 (r 2 + u 2 ) + u 2re) (6) 

where C 2 _i and C 2 are matrices similar to C\, Eq. (3), except that 6 X is replaced by 0 2 - 0, and 
0 2 , respectively, w 2 has the same structure as Cj x but with 0 2 replacing 0 U n(0 2 ) = [dj h x } T , r 2 = 
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lx 2 0] T , u 2 = [0 u 2 ] T and u 2re | = [0 u 2 ], in which u 2 = u 2 {x 2 ,t) and u 2 = «2(*2,0 are the elastic 
displacement and velocity, respectively. 

Using the analogy with the second body, the velocity of a point in the third body (second 
flexible arm) in terms of x 3 ,y 3 components can be shown to be 

V3 =C 3 _ 2 V 2 (L 2 ) + W 3 (r 3 + U3) + U 3re | 

=C 3 R<) + C 2 -\£j\T\{02) + C 3-2 {^2 [**2(^2) + u 2(^2jf)] + '-*2rel(^ / 2> 0} 

+ W 3 (r 3 4 - U3) -f U3 re l '' 


The fourth body consists of the end-effector and payload combined, and is treated as rigid. 
Following the established pattern, the velocity of a point in the fourth body in terms of x 4 ,y 4 
components is 

V4 =C 4 _3 V 3 ( L3) + W 4 r 4 

=C 4 Ro + C 4 -iwiri(0 2 ) + C 4 - 2 {w 2 [r 2 (L 2 ) + u 2 {L 2 ,t)} + u 2re i(I>2>0} 

+ C 4 _3 {w 3 [r 3 (i 3 ) + u 3 (l3,0] + «3rel(W)} + ^r 4 (8) 

The consistent kinernatical synthesis just described permits the formulation of the equations 
of motion for the whole system without invoking constraint equations. Such constraint equations 
must be used to eliminate redundant coordinates in a formulation in which equations of motion are 
derived separately for each body. 

3 . SPATIAL DISCRETIZATION OF THE FLEXIBLE ARMS 

The velocity expressions derived in Sec. 2 involve rigid-body motions depending on time 
alone and elastic motions depending on the spatial position and time. Equations of motion 
based on such formulations are hybrid, in the sense that the equations for the rigid-body motions 
are ordinary differential equations and the ones for the elastic motions are partial differential 
equations. Designing maneuvers and controls on the basis of hybrid differential equations is likely 
to cause serious difficulties, so that the only viable alternative is to transform the hybrid system 
into one consisting of ordinary differential equations alone. This amounts to discretization in space 
of the elastic displacements, which can be done by means of series expansions. Assuming that the 
flexible arms act as beams in bending, the elastic displacements can be expanded in the series 

«»(*»» 0 = < / , i>( x ») r /';(0 = 1 = 2, 3 (9, 

j=i 

where <£i>(x t ) are admissible functions, often referred to as shape functions, and i 7 »j (0 are 
generalized coordinates; <f>j and 77, are corresponding n, -dimensional vectors (1 = 2 , 3 ; j 

1,2 ,..-,n t ) 

The question arises as to the nature of the admissible functions. Clearly, the object is to 
approximate the displacements with as few terms in the series as possible. This is not a new 
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problem in structural dynamics, and the very same subject has been investigated recently in 
Ref. II, in which a new class of functions, referred to as quasi-comparison functions, has been 
introduced. Quasi-comparison functions are defined as linear combinations of admissible functions 
capable of satisfying the boundary conditions of the elastic member. As shown in Fig. 2, the beam 
is tangent to axis x, at 0,(i = 2,3). Hence, the admissible functions must be zero and their slope 
must be zero at x,- = 0. At x, = I,, the displacement, slope, bending moment and shearing force 
are generally nonzero. Quasi-comparison functions are linear combinations of functions possessing 
these characteristics. Admissible functions from a single family of functions do not possess the 
characteristics, but admissible functions from several suitable families can be combined to obtain 
them. In the case at hand, quasi-comparison functions can be obtained in the form of suitable 
linear combinations of clamped-free and clamped-clamped shape functions. 


4. LAGRANGE’S EQUATIONS 


Before we can derive Lagrange’s equations, we must produce expressions for the kinetic energy, 
potential energy and virtual work. To this end, and following the spatial discretization indicated 
by Eqs. (9), we introduce the configuration vector 


q(t) = [AW Y{t) 6\(t) 0 2 (t) 0 3 (t) 0 4 (t) V J(t) V T(t) J T (10) 

so that the velocity vectors, Eqs. (2), (6)-(8), can be written in the compact form 

V< = Z);q, i = 1,2, 3, 4 (11) 

where 


C0 1 

S0 1 

—2/1 0 

... 0 r l 




. — S0\ 

c9\ 

xj 0 

... 0 T . 




C0 2 

S0 2 

d\s(0 2 - 

1 

(M 

QS 

"tT 

1 

-0i) 

T 

~4 > 2 V2 

O 

o 

o 

o 

-S0 2 

C0 2 

d\c{0 2 — 

Oi) + k lS (0 2 - 

-0i) 

*2 

o 

o 

to K} 

o 


Then, the kinetic energy is simply 

T = \'tl VpMm, = iq T Mq 

~ l== i 2 

where 

M = 't[ Dj Didmi 

t — 1 

is the mass matrix. Typical entries in the mass matrix are 


mu =m, 
m H = - 


m 12 — 0 , m 1 3 = — (m 2 + m 3 + m^){h\c9\ + d\s6\) 

<t >2 + (m 3 + mi)<f)T(L 2 ) 1 T] 2 c6 2 - [5 2 + (m 3 + m i )L 2 \se 2 


(13) 


(14) 
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m is = - 


’ rp 

0 3 + m 4 0 3 (L 3 ) 


S #3 


™22 


— m, rri23 — ~( m 2 4 * m 3 + m^)(h\s6\ d\c9\) 


( 15 ) 


' 'J' p 

rri28 = 03 + m 40 3 (^ 3 ) 


cO 3 


m 88 = f 030l^ m 3 + m 4 0 3 (L3)0l(^3) 

*/Body 3 


in which 


m 


= y mi, 0 , = f 4>,dm„ * = 2 , 3 , 5 , = / x;dm„ * = 1,2, 3, 4 

" im,- ' /m « 

» = 1 


( 16 ) 


( 17 ) 


in 


The potential energy, assumed to be entirely due to bending, has the form 

V = 1 Eh [u 2 ( x o , 0] 2 dx ? + \j 0 3 EI * [ U 3( X3 ’ 4 )] rfx3 = 2 qT/ ^ q 

which E/i(i = 2 , 3 ) are bending stiffnesses and primes denote spatial derivatives. Moreover, 

K — block — diag [0 K2 ^3] 


is the stifTness matrix, where 

I<, = [ Li EIi4>"{<t>") T dxi, i = 2,3 

Jo 


( 19 ) 


are stiffness matrices for the flexible arms. 


Next, we propose to derive the virtual work expression. To this end, we must specify first the 
actuators to be used. There are three actuators acting on the platform, two thrusters F xl and 
F . acting in directions aligned with the body axes and a torquer Mi acting at O x . Three other 
torquers A02,M 3 and M 4 are located at the hinges 0 2 ,O 3 and 0 4 , respectively, the first acting on 
the platform and first arm, the second acting on the first and second arm and the third acting on 
the second arm and end-effector. In view of this, the virtual work can be written as follows: 


S\V =F X 1 (cos0i6X + sin MV") + (-sin0i6X + cosOrfY) + M\80\ 

+ M 2 <5 ( 02 - 0i) + M 3 H 3 + 4 + M 5 8 [0 2 + 02 T ( W 3 ) tj 2 ] 

+ M e <5 [02 + <t >2 ( 2 ^ 2 / 3 ) V 2 } + Ml 8 [03 + 0? ( W3) t| 3 ] + Af* [03 + 03 I (M./3) * 73 ) ( 20 ) 

where 8 X,8Y,... are virtual displacements. Moreover, denoting the angles between the two arms 
and between the second arm and the end-efFector by 


* =h 

*' =e< - h - 5 ^ 


*2 


=Li 


T3-L3 


= 63 — O2 — <j>2 (^2) V2 

= 04 — 03 — 03^ (^3) V3 


( 21 ) 
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we can write 


<503 = <503 - <502 - 0 '2 U 2 ) <5f? 2 > 6ip 4 = 8 O 4 - 60 3 - (L 3 ) 6t]j (22) 

Inserting Eqs. ( 22 ) into Eq. ( 20 ), we can express the virtual work in terms of generalized forces 
and generalized virtual displacements in the form 

<5 IV = Q T <5q (23) 

where Q = [Fy Fy ©i 02 ©3 ©4 Nj] r is the generalized force vector, in which 

Fx ~F X i cos - F y i sin 0 i, Fy = F x \ sin0i + F y \ cos0i 
0 1 —M\ — Mo, 02 — M 2 — A / 3 + A /5 -f M$ 

©3 — A /3 — M\ + A /7 + A/g, 04 = A /4 (24) 

N 2 =M 5 0' 2 (L 2 /3) + A/ 6 ^(2I 2 /3) - A/ 3 0'(L 2 ) 

N 3 =A/ 7 0' (L 3 /3) + A/ 8 ^ 3 (2L 3 /3) - A/ 4 0' 3 (/ 3 ) 

and <!>q = \ 8 X 8 Y S0\ 860 60 3 8O4 8tj % 8t is the generalized virtual displacement vector. 
Equations (24) express the generalized forces and torques in terms of the actual actuator forces 
and torques and can be expressed in the compact form 


Q = EF 

where F = [F x \ Fy 1 M\ M 2 . . . A/s] 7 is the actual control vector and 


(25) 


E = E(0 ,) = 

cos 0 \ — sin 0 \ 0 0 


sin 0] 
0 
0 
0 
0 
0 
0 


cos 0i 0 0 


1 -1 


0 

0 

0 


0 1 
0 0 
0 0 
0 0 
0 0 


0 

0 

0 

-1 

1 

0 

-02U2) 

0 


0 

0 

0 

0 

-1 

1 

0 


0 

0 

0 

1 

0 


0 

0 

0 

1 

0 


0 0 

L> 2 \ ±! / 2Z/9 ' 


0 

0 

0 

0 

1 


02(~3' i ) 02 (~ J 2 ) 0 


0 

0 

0 

0 

1 


— 03 U 3 ) 0 0 03 ( ) 03(^ 2 ) 


is a time-varying coefficient matrix, because 6 \ varies with time. 


(26) 


Lagrange’s equation can be expressed in the general symbolic vector form 

±<dT\_ST + dV_ = 

dt \dq) dq dq 


(27) 
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Observing that M = A/(q), we can write 


dT ... d (dT\ .... , ... 

a? =Mq ’ J, U, 1 = Mq + Mq 


dT 1 . T dM . dV 

a- -s-q. X" = 7 ^q 
9q 2 aq aq 

Inserting Eqs. (28) into Eq. (27), we obtain Lagrange’s equations in the more explicit form 

( ■ 1 . T dM\ . 

Mq + (A/ - 2 ^ ~dqj q + ^ q = ^ 


(28) 


111 W 


hich 


■ *+l n dM. . T dM 

M = § q 87 


q r dM jdq\ 

q T dM/dq 2 

q T dMjdqa+2n 


(29) 


(30) 


5. A PERTURBATION APPROACH TO THE CONTROL DESIGN 

Equation (29) represents a high-order system of nonlinear differential equations, and is not 
very suitable for control design. Hence, an approach capable of coping with the problems of high- 
dimensionality and nonlinearity is highly desirable. Such an approach must be based on the 
physics of the problem. The ideal maneuver is that in which the robot acts as if its arms were 
rigid. In reality, the arms are flexible, so that some elastic vibrations are likely to take place. It 
is reasonable to assume, however, that the elastic motions are one order of magnitude smaller 
than the maneuvering motions. This permits treatment of the elastic motions as perturbations 
on the maneuvering motions. In turn, the elastic perturbations give rise to perturbations in the 
’’rigid-body” maneuvering motions. This suggests a perturbation approach, whereby the problem 
is separated into a zero-order problem for the ’’rigid- body” maneuvering of the payload and a 
first-order problem for the control of the elastic motions and the perturbations in the rigid-body 
maneuvering motions. The zero-order problem is nonlinear, albeit of relatively low dimension. It 
can be solved independently and the control can be open loop. On the other hand, the first-order 
problem is linear, but of relatively high dimension. It is affected by the solution to the zero-order 
problem, where the effect is in the form of time- varying coefficients and persistent disturbances. 

The control for the first-order problem is to be closed loop. 

We consider a first-order perturbation solution characterized by 

q = qo + qi, Q = Qo + Ql (31) 

where the subscripts 0 and 1 denote zero-order and first-order quantities, with the zero-order 
quantities being one order of magnitude larger than the first-order ones. Inserting Eqs. (31) into 
Eq. (29) and separating quantities of different orders of magnitude, we obtain the equation for the 
zero-order problem 

A/oqo + (^M v - 2 ^^) qo = Qo = EqFo (32) 
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where q 0 = (X 0 Y 0 0 1O 0 2 o 030 040 0 T 0 T ] T , Qo = [Cyo Cyo ©10 ©20 ©30 ©40 0 T O r ] r are 
zero-order displacement and generalized control vectors, E 0 = E( 9 i0 ) is the matrix E, Eq. (26), 
evaluated at 0, = 0 1O , F 0 = [F z0 F y0 M l0 M 20 . . . Mg o] T and 


Mq = M ( qo ) , A'/„ = 


3M . 5Af . 


# 9 l q ° dq 2 

Moreover, we obtain the equation for the first-order problem 


qo 


dM . 1 I 

o qo 

^ 96+271 J lq=qo 


(33a, b) 


M 0 qi + (M„ + A/' - A-fJ) qj + ^Af. + M„ 


+ /f 


) qi = Q 


1 + Qj 


(34) 


where qj = [X, Yj 0 n 0 2! 0 3 l 041 V 2 »#] T , Qi = [F Xi F Y \ ©n ©21 ©31 ©41 N^] r are first- 
order displacement and generalized control vectors, Q d = [0 0 0 0 0 0 Fj 2 FJ 3 ] t is a persistent 
disturbance vector and 


M a = 


dM 
9 q 1 


qo 


dM .. 

dM 

dq 2 q ° " 

dq 6+2; 

6 +^" dM 


■ £ 

qo> 

a 

II 

0 


-qo 


q=qo 


6 +2n6+2n g2 M 

M^qi = 

i=l Jt=i 9 q } dqk 

. r 6 +2" 5 2 A/ 

M».,qi =qo L 


91*90.7 qo 


q=qo 


it=i <5q% 

From Eqs. (25) and (26), however, we can write 


9 i*qo 


q=qo 


(35a) 
(356) 
(35c) 
(35 d) 


Qi — E0F1 4 - F1F0 = F0F1 4 - Fjqi ( 36 ) 

where E\ = [dE/dQ\\8\ = 0 [o] 0 n. Moreover, the matrix F 0 * has the entries 
Fou — ~ {F z 10 sin 9 \ 0 4 - F y 10 cos 0 jo) 

Fq 2 j =F x 10 cos 010 - Fj,io sin 0 1O (37) 

Foij = 0 > 1 = 3 , 4 , . . . , 6 + n 2 4- 713; j = 2, 3 , . . . , 6 4- n 2 4- n 2 

In view of this, the equation for the first-order problem can be rewritten as 

M 0 q! 4- (M v 4-M'- Mj )q, + (M a + M vv - ~M' VV + K- F„*) qi = E 0 F, + Q d (38) 


6. TRAJECTORY PLANNING 


The mission consists of delivering the payload to a certain point in space and placing it 
in a certain orientation. For planar motion, the final payload configuration is defined by three 
variables, two translations and one rotation. The trajectory planning, designed to realize this 
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final configuration, will be carried out as if the robot system were rigid, with the expectation that 
all elastic motions and perturbations in the rigid-body maneuvering motions will be annihilated 
by the end of the maneuver. The rigid-body motion of the robot is described by the zero-order 
problem and it consists of six components, two translations of the platform and one rotation 
of each of the four bodies. This implies that a kinematical redundancy exists, as there is an 
infinity of ways a six-dimensional configuration can generate a three-dimensional trajectory. 

This redundancy can be removed by controlling three of the configuration variables, such as the 
translations and rotation of the platform, so as to conserve fuel. Under these circumstances, the 
rigid space robot can be treated as a nonredundant manipulator. 


Next, we denote the end-effector configuration by X E , so that from kinematics we can write 



X E = f(qo) 

(39) 

where f is a three-dimensional 

l vector function. From differential kinematics, we have 



X-e = T(qo)qo 

(40) 

where 

J(q 0 ) = [df/dqo] 

(41) 

is the 3x6 Jacobian matrix. 

Introducing the notation 






T 1 T 

qo = Q5 ! 

(42) 

where 

qs = (X 0 Fo 0io] T , q M = [020 030 04 o] T 

(43a, 6) 


are the controlled platform configuration vector and the open-loop controlled manipulator 
configuration vector, and partitioning the Jacobian matrix accordingly, or 


J = [is i Jm] (44) 

Eq. (40) can be rewritten as 

X E = Jsqs + Jm<\m ' 45 ' 

Then, on the assumption that q s is determined so as to minimize the fuel consumption, and for a 
given’end-efTector trajectory X E , we can determine the manipulator velocity vector from 

< 4 m — Jm fe-E ~ JsQs') 

The end-effector trajectory was taken in the form of a sinusoidal function so as to prevent excessive 
vibration. Finally, with qo given, we can obtain the required open-loop control Fo by inverse 
dynamics, which amounts to using Eq. (32). 
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7. FEEDBACK CONTROL OF THE ELASTIC MOTIONS AND RIGID-BODY PERTURBATIONS 


The elastic motions and the perturbations in the rigid-body maneuvering motions are governed 
by the equation defining the first-order problem, Eq. (38). The persistent disturbances are 
controlled open loop and all other disturbances are controlled closed loop. To this end, we express 
the control vector in the form 

Fi = Fio -f Fjc (47) 

where the subscripts o and c indicate open loop and closed loop, respectively. Recognizing that Eq 
is a rectangular matrix, the open-loop control can be written as 

Flo = ~ Eq Qj (48) 

in which 

El = (EjE 0 )~ l Ej (49) 

is the psuedo-inverse of Eq. 


For the closed-loop control, we consider a linear quadratic regulator (LQR), which requires 
recasting the equations of motion in state form. Adjoining the identity qi = q h the state 
equations can be expressed as 


x(0 = A(t)x(t) + B{t)E 0 u c {t) + B{t)Dd{t) 


(50) 


where x = [qf qf] 7 is the state vector, u c = F !c is the control vector, d = Q d is the disturbance 
vector and 


A = 


+ M vv - i M' vv + K 


-Mj)] 


B = 


Mo 1 


(51a) 


(516, c) 


0 / 

F 0 *) + M' 

, D=(l- EoEl) 

are coefficient matrices. It should be noted here that, if the matrix E 0 is not square, the matrix 
D is not zero, so that the open-loop control does not annihilate the persistent disturbances 
completely. As the number of actuator approaches the number of degrees of freedom of the system, 
the matrix Eq tends to become square. When the number of actuators coincides with the number 
of degrees of freedom the matrix Eq is square, in which case the pseudo-inverse becomes an exact 
inverse and the matrix D reduces to zero. 


The state equations, Eq. (50), possess time-varying coefficients and are subject to residual 
persistent disturbances. Due to difficulties in treating such systems in continuous time, we propose 
to discretize the state equations in time. Following the usual steps (Ref. 12), the state equations in 
discrete time can be shown to be 

x *+i = $Jt x /r + rjtF 0 jtu c jt + r *. Z>jt d jt , k = 0, 1, . . . (52) 

where 

x* =x(*r), u ck = u c {kT), d t = d (FT), fc = 0,1,... 

=exp A U T, V k = (exp A k T - I)A]. x B k , k = 0, 1 , . . . (53) 

E 0 t =E 0 (kT ), D k = D(kT), k = 0, 1, . . . 
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in which T is the sampling period. In view of the above discussion, we assume that the effect of 
the persistent disturbances has been reduced drastically by the feedforward control, and design the 
feedback control in its absence. This design is according to a discrete-time LQR with prescribed 
degree of stability. To this end, we consider the performance measure 

J — x T N P N x N + e2ak { x lQk x k + ^ k R k u ck ) (54) 

*=o 


where Pyy and Qk are symmetric positive semidefinite matrices, is a symmetric positive definite 
matrix, a is a nonnegative constant defining the degree of stability and NT is the final sampling 
time. 

The optimization process using the performance measure given by Eq. (54) can be reduced to 
a standard discrete-time LQR form by means of the transformation 

Xjfc = C° fc xjt, Udfc = e ah u ck , P N = e~ 2aN Pn (55a, 6, c) 

Multiplying Eqs. (52) through by using Eqs. (55a, b) and ignoring the small perturbing 

term, we obtain the new state equations 

X fc+1 = e® ($ fc x fc + r k E ok u ck ) , k = 0, 1, . . . , N - 1 (56) 

Similarly, inserting Eqs. (55) into Eq. (54), we obtain the new performance measure 

/V-l 

J - xJfPtfXH + (xjfQjtx* + uJ k R k n ck ) (57) 

Jt=o 

It can be shown (Ref. 12) that the optimal control law has the form 

ficJt = G k x k , fc = 0,1,...,#- 1 (58) 

where Gk are gain matrices obtained from the discrete-time Riccati equations 

Gyv-i = - (e 2 “£^yv_,T^_,/ > yy+i-»ryy_,£o,JV-« + R-N-i) 1 e 2a 

i = l,2,...,N;P = e- 2aN P N (59a) 

Pfit-i =e 2 ° ['t’.v-, 4- T tl-iEo,n -iGN-i) Pn+i-i ($N-i + r//_iEo,W-iaAT_i) , 

+ G T „_ i R N -iG H -> + QN-i,i = h2,--.N;h=e- 2 ° N P l , (596) 

A A 9 

Equations (59a) and (59b) are evaluated alternately for Gyv_i, Pft-i, Gyv-2, Pn- 2, ■ ■ ■ , Go, given 
the final value of P //. 

Inserting the control law, Eqs. (58), into Eqs. (56), we obtain the closed-loop transformed 
state equations 

X t+1 = e“ ($>* + r k E ok G k ) x kl fc = 0,1,... (60) 
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Then, recalling Eq. (55a) and restoring the persistent disturbance term, the closed-loop state 
equations for the original system can be written in the form 

x fc+i = ($fc + TkEokGt) Xk + r fc £>jfedt, fc = 0,1 ,... (61) 


8. NUMERICAL EXAMPLE 


The example involves the flexible space robot shown in Fig. 1. Numerical values for the system 
parameters are as follows: 


L i =1 m, d\ ~ 0.5 m, L 2 = L 3 = 5m, Li = 1.66m 
mi =10 kg, mi — m 3 = 1kg, = 0.1 kg 

J\ =20 kgm 2 , J 2 = 3 kgm 2 , EI 2 = Eh = 122.28 Nm 2 

The quasi-comparison functions for the flexible arm were chosen as a linear combination of 
clamped-free and clamped-clamped shape functions. Both families of shape functions have the 
functional form 


4>i 


-j= [cosh A {x/L — cos \ t x/ L — <?{ (sinh \ % xj L — sin A ix/ L )\ , i = 1,2, 


i n 


The values of A,- and (j{ are given in Table 1. They correspond to two clamped-free and three 
clamped-clamped shape functions, for a total of n = 5 for each flexible arm. 


The initial and final end-efFector positions are defined by 

X x =9.757 rn, Y x — 1.914 m, 8^f = 0 rad 

Xf =5.000 m, Yj - 1.914 m, 8^f = 7 t /2 rad 

and we note that the path from the initial to the final position represents a straight-line 
translation, while the orientation undergoes a 90° change. In terms of time, the translational and 
rotational accelerations represent one-cycle sinusoidal curves. 

The maneuver time is tf = 2.5 s. The zero-order actuator forces and torques to carry out the 
maneuver are shown in Fig. 3. 

The control of the elastic motions and the perturbations in the rigid-body motions was 

extended to t = 4 s. Not that for 2.5 s < t < 4 s the system is time-invariant, during which time 

the control gains can be regarded as constant. The weighting matrices in the performance measure 
are 

Qk = 107, R k = /, P N = 10/ 

The degree of stability constant is a = 0.1. Moreover, the samping period is T = 0.01 s and the 
number of time increments is N — 350. 


Time-lapse plots of the uncontrolled and controlled robot configuration are shown in Figs. 4a 
and 4b, respectively, at the instants 0, 1, 1.5 and 2.5 s. Figures 5 and 6 show time histories of the 


35 



errors in the end-effector position. The discrete-time open-loop and closed-loop poles are given in 
Tables 2 and 3. For comparison, Fig. 7 shows the time history of the errors and Table 4 gives the 

closed-loop poles for a = 1. 

It should be pointed out that the actuator dynamics is also included in the formulation and the 
numerical results, but the effect turned out to be small. 


9. CONCLUSIONS 

An orderly kinematic synthesis in conjunction with the Lagrangian approach permits the 
derivation of the equations of motion for an articulated multibody system, such as those describing 
the dynamical behavior of a flexible space robot, without the imposition of constraints. The 
equations are nonlinear and of relatively high order. A perturbation approach permits the 
separation of the problem into a zero-order problem (in a perturbation sense) for the rigid-body 
maneuvering of the space robot and a first-order problem for the control of the elastic motions and 
the perturbations from the rigid-body motions. The robot mission consists of carrying a payload 
over a prescribed trajectory and placing it in a cerrtain orientation relative to the inertial space. 
This represents the zero-order problem and the control can be carried out open loop. The first- 
order equations defining the first-order problem (in a perturbation sense) are linear, time-varying, 
of high-order and subject to persistent disturbances. The persistent disturbances are treated by 
means of feedforward control. All other disturbances are controlled closed loop, with the feedback 
control being designed by means of discrete-time LQR theory with prescribed degree of stability. 

In a numerical example, the controls derived by the perturbation approach are found to work 
satisfactorily when applied to the original nonlinear system. 
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Table 1. Shape Function Coefficients Table 2. Discrete- Time Open- Loop Poles 


i 

h 

<Ti 

1 

1.8751040 7 

0.734095514 

2 

4.69409113 

1.018467319 

3 

7.85475744 

0.999224497 

4 

10.99554073 

1.000033553 

5 

14.13716839 

0.999998550 


No. 

Pole Location 

Mag. 

No. 

Pole Location 

Mag. 

1.2 

-0.840+0.5431 

1.000 

17,18 

0.991+0. 13 Si 

1.000 

3.4 

-0.778+0.629i 

1.000 

19,20 

0.994+0.1 07i 

1.000 

5,6 

-0.700 ±0.7141 

1.000 

21,22 

1.000 

1.000 

7,8 

-0.690+0.7241 

1.000 

23,24 

1.000 

1.000 

9,10 

0.586+0.8101 

1.000 

25,26 

1.000 

1.000 

11,12 

0.629+0.7781 

1.000 

27,28 

1.000 

1.000 

13,14 

0.902+0.4311 

1.000 

29,30 

1.000 

1.000 

15,16 

0.921+0.390i 

1.000 

31,32 

1.000 

1.000 
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Table 3. Discrete-Time Closed-Loop Poles Table 4. Discrete-Time Closed-Loop Poles 


No. Pole Location 


0.493xtO 


0. 1 20x10 


Mag. 1 No. Pole Location I Mag. 


0.572 Il8, 19 0. 803±0. 976x10 i jo.809 


0.005 20 0-805 


1 0.012 21 0.807 


1 0. 1 25 122,23 0.814+0.362xltfi |o.014 


0.204 |0.204 1 24,25 1 0.81 7 


0.302±0.148i 1 0. 3 36 I 26 0.817 


9.10 0.454±0.493i 


0.670 27 0.819 


1 1 ,1 2 1 0.468±O.323i 10.569 | 28.29 |0.821±0.366xl<)‘ i|0.821 


0.733 1 30 |0.Q22 


3.14 0.536±0.500i 


0.749±0.860xl'6 i 0.754 31 0.822 


17 10.792 0.792 32 0.827 


Pole Location 


Mag. No. Pole Location | Mag. 


-0.566 |o.S66 1 7,1 8 0.1 39±0.844xlfri 0.139 


2,3 | -0. 1 60 ±0. 1 86» 0.246 19,20 0.15at0.022i 0.152 

0.296 21,22 0.187±0.145i 0.236 


0.062±0.088i |o.108 I 23,24 1 0.1 98±0.288xlO’i 0.200 


-0.177x10’’ 0.018 25 0.251 


-0.177x10 

0.779x1 &0.209i |o.209 26,27 0.252±0.180i |p.310 


11,1 2 1 0.072±0.088i 10.114 28 ' 29 0-279+0.4901 0.564 


13,14 0.1 1 8±0.016i b.119 | 30*31 1 0.328±0.1 48i | 0 - 360 


15.1610.13210.920x1(3" |0.1 32 | 32 | 0.430 


m 3’U,EI 3 Q 


^.UEU 


till 


Figure 1. Flexible Space Robot 
















































































































